direct kinematics

正运动学